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^ ABSTRACT: ^ 

kalman filter has been successfully used as an estimator in recursive linear systems. For 
nonlinear systems extended kalman filter is more suitable for use. In case the target trajectory is 
steady, tracking can be achieved by Kalman filte. But target maneuvering makes tracking process 
more complicated. Extended kalman filter gives real time tracking for such targets, provided we have 
high speed processor. This work describes and examines the use of this algorithm in missile and 
target tracking. 
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I. INTRODUCTION: 

The kalman filter is an algorithm which uses a series of measurements observed over time, containing 
noise (random variations) and other inaccuracies, and produces estimates of unknown variables that tend to be 
more precise than those that would be based on a single measurement alone [1]. In tracking problems for 
example, with the assumption that the system parameters change linearly, Kalman filter equations operate 
properly as has been shown in a previous work [2]. Many practical systems have non-linear state update or 
measurement equations. The Kalman filter can be applied to a linearised version of these equations with loss of 
optimality [4]. In this research extended Kalman filter is used to estimate the position of a missile without losing 
optimality if the system is nonlinear. A simulation is conduct to test assumptions made. 



II. KALMAN FILTER METHOD AND PHASES: 

The Kalman filter estimates a process by using a form of feedback control: the filter estimates the 
process state at some time and then obtains feedback in the form of (noisy) measurements. Equations for the 
Kalman filter fall into two phases: time update and measurement update [3]. 

The Kalman filter model assumes the true state at time k is evolved from the state at (k - 1) according to 

= F,,x,._i + B f; u h + w k |i| 

where 



• Ft is the state transition model which is applied to the previous state x*-i; 

• B k is the control-input model which is applied to the control vector u^; 

• Wa is the process noise which is assumed to be drawn from a zero mean multivariate normal 
distribution with covariance Q k . 



w„~A r (0,Q,) [2] 

At time k an observation (or measurement) z k of the true state x k is made according to 

Z fc = HfcXfc + Vfc [3] 

where H k is the observation model which maps the true state space into the observed space and v* is the 
observation noise which is assumed to be zero mean Gaussian white noise with covariance R s . 

v fc ^iV(0,R fc ) [4] 

The initial state, and the noise vectors at each step {x 0 , Wi, W*, Vi ... V*} are all assumed to be mutually 
independent. In practice, their matrices might change with each time step or measurement, however sometimes, 
as it is considered in this case, they are assumed to be constant. 
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The time update equations are responsible for projecting forward (in time) the current state and error covariance 
estimates to obtain the a priori estimates for the next time step. The measurement update equations are 
responsible for the feedback — i.e. for incorporating a new measurement into the a priori estimate to obtain an 
improved a posteriori estimate. 

In short the time update projects the current state estimate ahead in time. The measurement update adjusts the 
projected estimate by an actual measurement at that time. 

After each time and measurement update pair, the process is repeated with the previous a posteriori estimates 
used to project or predict the new a priori estimates. This recursive nature is one of the very appealing features 
of the Kalman filter. 

III. EXTENDED KALMAN FILTER IMPLEMENTATION: 

If the process to be estimated and (or) the measurement relationship to the process is non-linear then a 
Kalman filter that linearizes about the current mean and covariance is referred to as an extended Kalman filter or 
EKF [4]. The EKF utilizes the first term in a Taylor expansion of the nonlinear function [5]. 
The approach adopted for implementing Kalman Filter is also valid in the case of extended Kalman Filter ie.,the 
two phases: Time Update ("Predict") and Measurement Update ("Correct") [2] are the same the difference will 
be in the equations. For the extended Kalman Filter the equations obtained are as follows: 

Xk= f (x k . h U k l , [5] 

with a measurement z that is 

z k = h (x k ,v k ) [6] 

where the random variables w k and v k again represent the process and measurement noise. In this case the non- 
linear function f in the difference equation [1] relates the state at the previous time step k-1 to the state at the 
current time step k. It includes as parameters any driving function u k _i and the zero-mean process noise w k . The 
non-linear function h in the measurement equation [2] relates the state Xk to the measurement z k . 
In practice of course one does not know the individual values of the noise w k and v k at each time step. However, 
one can approximate the state and measurement vector without them as 

X~ k = f (X~ k - U lA- h 0) [7] 

and 

Z\ = h (X\ . 0) [8] 

where x~ k is some a posteriori estimate of the state (from a previous time step k) [4] . 

IV. ALGORITHM: 

The algorithm used in Kalman filter approach and Radar detection with a little modification is valid for 
the Extended Kalman Filter implementation, the new algorithm is as follows: 
Start 

— generate a hypothetical target . 

(azimuth = 45 degrees, range = 200 km., height = 4000meter, heading = 90 degrees east, speed = 800 
km/hr ). 

— generate a tracker aircraft ( or missile). 

(azimuth = 45 digress, range = 70 km., heading = 90 degrees east, speed = 1200 km/hr ). 
( The tracker height should follow the data acquired from the height finder Radar in order to 
Approximate the real height of the target.) 

— asuuume that both the target and the tracker are detected by three dimensional Radar or azimth and range 
Radar plus height finder Radar.. 

— apply Extended Kalman filter prediction formula to give the estimated target position. 

— maneuver the heading of the tracker based on the estimated coordinates of the target. 

— if the distance between the target and the tracker approaches zero is true, 
then collision is assumed. 

otherwise the target and the tracker are in visual contact, 
end 

V. RESULTS: 

With the assumptions made above and values of F, G, H are known the Kalman filter equations 
resulted in values presented in table 1 . Estimated values are a bit far from the measured values at the beginning 
of the observation but they are very close to the measured values when the object is close to the target. The 
implementation of the extended kalman Filter equations produced a more accurate values specially at the early 
stages of the process. 
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Table 1: results 





True Values 




Estimates 


Errors in Estimates 




Position 


Velocity 


Meas. 


Position 


Velocity 


Position 


Velocity 


T=Kt 


Xj 


x 2 


Z(k) 


X t (K) 


X 2 (k) 


Pn(k) 


P 2 2(k) 


0 


100 


0 




95 


1 


10 


1 


1 


99.5 


- 1 


100 


99.6 


0.4 


0.9 


0.9 


2 


97.0 


-2.4 


96.4 


97.2 


-2.1 


0.7 


0.6 


3 


95.0 


-3.2 


94.0 


94.8 


-3.0 


0.7 


0.3 


4 


92.0 


-4 


92.7 


92.4 


-3.7 


0.6 


0.2 


5 


89.0 


-4.8 


89.2 


89.4 


-4.6 


0.5 


0.1 



The results shown in Table 1 assumes that both target and the tracker are approximately close in height. 



VI. CONCLUSION: 

Kalman Filters and Extended Kalmn Filter (EKF) produce estimates that are very near to measured 
values which means both can be used for the estimation of the position of an attacking missile. The EKF 
implementation results in values that are much close to the real values than those produced by KF estimates and 
hence more reliable positioning and tracking can be achieved. 
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